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Abstract 

For space based robots in which the base is free to move, mo- 
tion planning and control is complicated by uncertainties in the 
inertial properties of the manipulator and its load. This paper 
presents a new adaptive control method for space based robots 
which achieves globally stable trajectory tracking in the presence 
of uncertainties in the inertial parameters of the system. 

The paper begins with a partitioning of the fifteen degree of 
freedom system dynamics into two components: a nine degree 
of freedom invertible portion and a six degree of freedom non- 
invertible portion. The controller is then designed to achieve 
trajectory tracking of the invertible portion of the system. This 
portion of the system consist of the manipulator joint positions 
and the orientation of the base. The motion of the noninvertible 
portion is bounded, but unpredictable. This portion of the sys- 
tem consist of the position of the robot’s base and the position 
of the reaction wheels. 

1 Introduction 

In recent years the control of space based manipulators has r« 
ceived increased attention. The main difference between span 
based robots and their terrestrial counterpart is the dynamic 
coupling between the manipulator and its floating base. This 
results in a similar, but uniquely different form for the kine- 
matic and dynamic equations of motion. 

Several researchers have focused on the forward and inverse 
kinematics problem [1, 2, 3, 4]. One of the interesting parts of 
these results is the formulation of the dynamic Jacobian matrix. 
It is now recognized that singularities may occur in the trans- 
formation from end-effector velocities to joint velocites which 
are at different locations than the normal kinematic singularity 
points. Another interesting result is the concept of the virtual 
manipulator, [2]. If the mass properties of each link are known, 
then it can be shown that a virtual manipulator can be obtained 
for use in the inverse kinematics problem. The advantage of the 
virtual manipulator is that algorithms developed for terrestrial 
based manipulators can be applied. 

The dynamics of multibody space based systems has been 
researched for many years [5, 6, 7]. In many ways the control of 
space based robots is similar to the problems traditionally faced 
in satellite control. The main difference is the articulated nature 


of the robot. Free floating space based robot control has only 
recently gained attention [8, 9]. 

In both the kinematics problem and the control problems 
previous researchers have assumed either the mass properties 
of the system are completely known or the momentum of the 
system is zero. This paper presents a control method in which 
neither of the assumptions are made. 

We begin this paper with a description of the system consid- 
ered and the formulation of the dynamic equations of motion. 
The fifteen degree of freedom system dynamics are partitioned 
into two components: a nine degree of freedom invertible por- 
tion and a six degree of freedom noninvertible portion. The 
in vert able portion of the system consist of the manipulator joint 
positions and the orientation of the base. The motion of the 
noninvertible portion is bounded, but unpredictable. This por- 
tion of the system consist of the position of the robot’s base and 
and the velocity of the reaction wheels. An adaptive controller 
is then presented to achieve trajectory tracking of the invertible 
portion of the system. Finally, a summary of the main results 
and conclusions of the paper are presented. 


2 Equations of Motion 

T^he system we are considering is an n degree of freedom se- 
rial link manipulator, with rotational or translational joints, 
mounted on a base containing three reaction wheels. It is as- 
sumed that no external forces are moments are applied to the 
system. However, no assumptions have been made concerning 
the initial momentum of the system. 

Associated with each link is a right handed Cartesian coordi- 
nate system whose position and orientation is fixed with respect 
to the associated link. This is illustrated for link j in Figure 1. 
The location of this coordinate frame with respect to an inertial 
reference frame is denoted by the homogeneous transform Tj. 

A Floating Referenced Frame is fixed at a specified position 
on the Base with the same orientation as the inertial reference 
frame. Its location is denoted by the homogeneous transform 
T 0 . 

The Base link is numbered 3 and its coordinate frame is 
located at the same location as the Floating Reference Frame, 
but at a different orientation. It’s location is denoted by the 
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Figure 1: Illustration of Robot 

homogeneous transform, T3. Between the Floating Refe-mn <- 
Frame and the Base frame are two fictitious links of zero nia^. 
The three joints between these links represent the relative change 
in orientation of the Base with respect to the Floating Reference 
Frame. 

The manipulator is attached to the Base and the links are 
numbered from 4 to n + 3. In addition three reaction wheels are 
located inside the Base. The wheels are numbered from n + 4 
to n + 6. 


Legend 
O Joint 
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Floating Reference Frame 
Figure 2: Configuration of Space Based Robot 

2.1 Reaction Wheels 

The torque delivered to the base of the robot to control its ori- 
entation is provided by a set of reaction wheels. The position 
variables associated with these wheels are cyclic and therefore it 
considerably simplifies the analysis by writing the kinetic energy 
and the resulting equations of motion in terms of the generalized 
momentum, lj, associated with these wheels. 

, - d JL 

3 dqj 

The main objective of this section is to write the kinetic energy 
kinetic energy in terms of these generalized momentum. To this 
end, we consider the kinetic energy of the j - th reaction wheel, 


Ki = ^TR{TjDjT]) 

We will show this can be written in the following form: 


( 2 ) 


The configuration of the complete system is a tree structure 
as illustrated in figure 2 for the case of n = 6. Considering the 
Floating Reference Frame to be the base of the tree, each joint in 
the system is numbered the same as the immediate descendant 
in the tree. The position of the i — th joint is denoted by </,. 


The kinetic energy of the system is given by the following 
equation. 


K 



u tine D{ is the constant pseudo inertia, matrix for link i re fern ■ 1 

:<> link i coordinates. [10. 11], and 7 'It{\ denotes the tra • 

erator. 


f x 2 dm f xydm f xzdm / xdm * 

J xydm f y 2 dm f yzdm f ydm 

f xzdm / yzdm / z 2 dm f zdm 

f xdm j ydm J zdm f dm 

where the integration is carried out over the entire link, and 
r = [x,y,2, l) r is the position vector of the mass element with 
respect to link i coordinates. 




dm - 


Kj = l -TR{T,E ] fl} + 

where J 3 is the moment of inertia of the j — th reaction wheel 
about it’s axis of rotation and Ej is a constant matrix. 


We begin with some notation. Let x be an arbitrary 6x1 
vector, which has been partitioned into two 3x1 vectors, a and 


b. 


x — 


a 

b 


and define the matrix function R(x) as 


R(x) = 


k(a) b ‘ 

000 0 


where k() is a 3 X 3 matrix function such that for any two 3 x 1 
vectors a and y, k(a)y = a x y, where x denotes the vector 
cross product. 


With this notation, we can write the time derivative of T 3 
in the form: 

Tj = R(s.j)Tj (3) 


where 


3 

2} =2 0 + + £j<jj 

1 = 1 
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«3 = ^2,9, 


Po = 1° 


The vector p^ is the position vector of the Floating Reference 
Frame and, in general, for any joint k, 


Zk 
0 1 


if joint k is rotational 


if joint k is translational 


where 0 is the null vector and n k is a unit vector along the 
axis of rotation if the joint is rotational, or a unit vector in the 
direction of translation if the joint is translational. The vector r k 
is a position vector of an arbitrary point on the axis of rotation 
of the joint if rotational. The vectors n k , r k , and p^ are defined 
relative to the inertial coordinate frame. 

With this notation we can write: 

Kj = ^TRlR^TjDjTjmvf} 

The matrix TjDjTj is the pseudo inertia matrix of the j — th 
reaction wheel referred to the inertial coordinate frame. We now 
partition TjDjTj into two parts: 


TjDjTj = Nf + Nj 


N* = J*n 3 nj + rrijr 3 rJ 
N j = ±J ] (I-ee T - 2n J nJ) 

where Jj is the moment of inertia of the reaction wheel about 
it’s axis of rotation, Jj is the moment of inertia about an axis 
orthogonal to the rotational axis, and 


With this partitioning we note that 


and since. 


we get: 


= o 


R(Vj) = -R(&) + R(Sj)qj 


K> = ir«{Jl(a 3 )JV? *(S 3 ) T } + ^TR{R(v ] )N J R{v J f} 
From equation 1: 


= TR{R(s 1 )T jDjT } } 

= Jj( n J u 3 + ij) 

where u 3 is the angular velocity of the Base. 


Direct expansion reveals that: 


f? = JjTRiRi^NjRUjf) 


Thus, we can write: 


Kj = -TR{R(sz)N* R(vz) t } + -J-'lj 


Finally, we note that 

Ej=Ti l N*(Ti i ) T 

is a constant matrix. We can therefore write: 

Kj = ^TRiT^Tl) + 
which is the desired result. 

This allows us to rewrite the total kinetic energy in terms of 
the generalized momentum of the reaction wheels. We obtain, 

n+3 ^ n+6 

K = £ -TR&iBiTi } + Y. 


Di 4- E n + 4 + E r 


+5 -r &n + 6 


if i 3 


It is of some interest to note that D^ is the 4x4 counterpart of 
the spatial articulated moment of inertia matrix, [12]. 

Note, for k < 3, 

Uj = TR{R(s } )T J D J TjR(s k f} 

= Jj(nfn h ) 

and 

dlj 1 t • j ( \ 

^ - = Jjrtj n k = JjUj( u> k X n k ) 

So that, 

d / dlj \ dlj . j T / \T 

Tt{df k )-Wk = injnk= j[u,3 * ni) nk 

For the manipulator joints, n + 4 > k > 3, 

dh = dh = 0 
dq k dq k 

2.2 Elimination of Base Velocity 

The form of the equation for the kinetic energy of the system 
given in equation 5 is defined in terms of the velocities relative 
to the inertial coordinate frame. Our objective in this section is 
to rewrite this equation in terms of velocities relative to Floating 
Reference Frame. That is, we will eliminate the term p Q found 
in equation 5. This is done by rewriting this equation in terms 
of the velocity of the system center of mass. 


We begin by noting that: 


Ti = T 0 Ai 
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where A{ is the homogeneous transform of link i coordinates 
with respect to the Floating Reference Frame. Thus, 


n+3 i 

+ Y -TR{p'e T n,e(p c ) T } 

+ 


T{ = To + ToA : - 
= p 0 e T + Ai 


( 6 ) 


where e = [0 0 0 l] T . Note that: 


T 0 = 


1 0 0 

o 1 0 Pq 

0 0 1 
0 0 0 


The position of the center of mass of link j is given by: 
p c i = 

where, rj = constant , is the location of the center of mass of 
link j with respect to link j coordinates. This is illustrated in 
figure 1. Note that is the center of mass of the combination 
of the Base and the three reaction wheels. From equation 6 we 
get: 

Pj = Tjr) = p 0 + A,r c j 

By definition of the system center of mass, we have: 

n+3 n+3 

m TP c = Y m jp c i = Y m jT] r ] 

j=3 j=3 

n+3 n+3 

= Y m jPo+ Y m i*i r J 

J = 3 1=3 

n+3 

= rn T p 0 + Y m i * j rC j 

1=3 

where m,j is the mass of link j and m? is the total mass of the 
system. So the linear velocity of the Floating Frame is: 

n+3 

P°=-Y,— A ’ r i + P 

Substituting this into equation 6 gives: 

T, = p c e T + A, - Y —A 1 r c e T 

U m T 

n+3 

= p CeT + Y A i c 'i 

1=3 


where 

( I- ULl 

\ rn T j 

Substituting this into equation 5 gives 


- if i = j 

e* if i ^ j 


n+3 


K = 


n+6 


YoTR{T i n,T‘}+ Y ^f l ‘i 


i=3 
n+3 n+3 n+3 


J=n + ‘l 


= yyyI tr {^i c ‘i^ c i^} 


i=3 j=3 k= 3 ‘ 


n+3 n+3 


+ Y'Yi T,{ {AiC.i£>MP c ) r } 

«=3 j=3 L 
n+3 n+3 , 

+ YYrJn{p c ^n.,ciAl) 

i'=3 k = 3 


t=3 

n+6 


Y k" 1 /? 


j=n+4 


2 J J 


and since, 


n+3 

Y C >MP C ) T = o 

t=3 


We obtain, 

**+3 n+3 . n+6 

K = ]C }kA k } + ^2 rt 1 + 9 (7) 


;=3 k=3 ‘ 


j=n+4 


where 


U 


jk — 


n+3 

Y Cijn.ci 

i=3 


:r % r V T if i ~ k 

m i rn k ‘c( r c\T 


^■3 m-T ’ jy 

r c } (rl) T if j*k 


ri+3 

= Yl T R{p c e T D ie (p c ) T ) 


1=3 

^m T (p c ) T p c 


2.3 Lagrange’s Equation 

Lagrange’s equation is used to obtain the dynamic equations of 
motion. 

_ d dK dK 

r * dt dq t dq t 

where r, is the actuator torque if a rotational joint or actuator 
force if a translational joint. For the reaction wheels, this equa- 
tion is particularly easy to evaluate since the position variables 
are cyclic. That is: 

dK 
dqi 

So that, 

dli 


0 


1 dt 

where r, is the actuator torque of the i — th reaction wheel. 
For the remaining variables, we note that: 
dAj _ OAj 

dq t dq t 

dt l dq , J dqi 


and 


Hence, 


M 

dq t 


n+3 n+3 ■ 




j=3 k= 3 ‘ 


dq t 


n+3 n+3 . dAi 

j=3 k = 3 £ '• 

n JZ . i , dij . 

+ E.V' 

j = n + 4 ■' 
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n+3 n+3 r\ jk 

j=3 *=3 uq ' 

, 1 , dl, . 

+ 


since U T k] = U jk . 
Similarly: 


3K 

dqi 


n+3 n+3 . Q 4 T 

EE 

j=3 fc=3 J 
n+3 n+3 a 

+ SEmj«W] 

j=3 <c=3 Z ° (h 

, 1 , dl ]s 

+ JLW 


j=n+4 

n+3 n+3 ^ \ 

j=3 Jc=3 ^ 


+ £<7# 

j = n+4 J 3 OC]l 

since = U jk . 

Therefore, the equations of motion are: 


n+3 n+3 
j=3 k=3 


n = 'ZT, TR {^ u ^l) + u < 


where 


and 


f nju if i < 3 
Ui ~ \ 0 if 3 < i < n 


+ 3 


n +6 ^ n +6 

u = J2 Ti ( n -^) = £ (njr > + "3 X rijlj ) 


J=n+ 4 


J — n+4 


( 8 ) 


(!" 


Since there is no external torque applied to the Base, the r t - 
are zero for * < 3. Therefore, to simplify the development of the 
controller we make the following definitions. For 0 < i < n 4- 4 
let, 

Pi — T{ — U{ (10) 

The equations of motion then become, for 0 < i < n + 4: 


n+3 n+3 a 4 

j= 3 Jt=3 ^ 


(11) 


3.1 Method of Control 

The controller is a modified version of an inverse dynamic con- 
troller with adaptation. Let q be an (ra + 3) X 1 vector of the 
joint positions which includes the three orientation angles of the 
Base and the n joint angles of the manipulator. We start by 
defining the variable, q in terms of the position and velocity 
errors, q e = q- q d . Let: 


9 = 9 e + Me 


( 12 ) 


where A is a positive definite diagonal matrix with positive di- 
agonal components A, and q d is the desired value of q. Thinking 
of q as an input, this defines an exponentially stable and strictly 
proper transfer function between q and q e . The method of con- 
trol is to select the control law and adaptation law such that q 
is an L 2 function. It can be shown that, [13]: 


if q € L 2 then 


q e € L 2 n 

q e is continuous 
q e (t) -► 0 as t — ► oo 


Thus, we have proven that the position and velocity tracking 
errors have converged to zero if we can show that q is an L 2 
function. 

A judicious choice of the norm of q is a critical part of the 
method. The following norm K is an appropriate choice: 


n+3 n+3 ^ 

^ = -TR{AjV ik A k } > 0 V<^0 

;=3 k - 3 Z 


where 


A k = y -7j — <i, 

,tr d( i> 


The time derivative of K is: 

dK n+3 n+3 


dt 


j = 3 k=3 Z 

n+3 n+3 -t , " T 

j= 3 Jt=3 
n+3 n+3 . 

= 'Z'£TR{A i U jk A k } 

j=3 k=3 


3.2 The Controller 


For the remainder of this paper, we will consider p, to be the 
inputs to the system. If the pi are given, the actuator inputs r 3 
can be obtained from equations 8 through 10. 

3 Adaptive Controller 

In this section we present the control law and adaptation law so 
that the system tracts onto the desired joint trajectory. Global 
asymptotic stability is proven and a recursive formulation of 1 1 
controller is provided for computational efficiency. 


From equation 12 we get: 


9 = <ld + Me 

(13) 

where q = q — q. From this we get: 


9 = 9d + Me 

(14) 

Defining: 

a V' dAk \ 
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Then, the control law is: 

n+3 n+3 a a 

Pi = E E TR ^°M k k - 7^,) T } (15) 

>= 3 Jt=3 

and the adaptation law is: 

: ■ T” • 

Ujk = -GjkAj (A k - jA k ) (16) 

where 7 and ajfc are positive constants, and U j k is current es- 
timate of Ujk- Note that only q and q are required for control 
and not q . Also, the acceleration, q , is not required. 

3.3 Stability Proof 

We define the nonnegative function F(/): 

n+3 n+3 

V(t)=R+l/2'E'Et t J k 'TR{U ik U ji ) (IT) 

j = 3 k= 3 

where the are positive constants, and = U jk - U jk is 
the error in the estimate of U 

To prove stability we first show that V(t) < 0. We start by 
substituting equation 15 into the equations of motion, equation 
11. This gives: 


Thus, 

n+3 n+3 „ , 

= 

;=3 k—3 

n+3 n+3 , j . 

- 

3=3 *=3 

Where we have used the trace identity T R{ABC} = TR{BC A) 
for any square matrices A,B, and C. Adding and subtracting 
27 K gives: 

dK n +3 

-rr = - £ E TR{U ]k (A k - 7 A k ) T Aj) - 2 yK (18) 

j = 3 k = 3 

Thus, if there are no errors in the parameter estimates, U jk — 0, 
then K satisfies the linear equation, dK /dt + 27 A' = 0 and, 
hence, K(t) = e~ 2 lt I\( 0 ) and the stability result immediately 
follows. However, for the case in point, the parameter values 
are not initially known and we must proceed further. 

From equation 17 we get: 

j fs n+3 n+3 . j* 

j = 3 k=3 

Substituting in equation 18 gives: 


dK 

dt 


0 = 


n+3 n+3 a 4 .. x 

EE TR {-ar( u ^Al-u„A k )} 

j=3 k=3 0<ii 

n+3 n+3 


j= 3 k = 3 ° q ' 


n+3 n+3 s) A .. •j- j' 

E E TR{^(U lk ( A k - A k ) + (U lk - U jk )A k )} 

j=3 k=3 ° h 

n+3 n+3 


3-3 k = 3 


n-f 3 n+3 Fi A *V T 

= E E tr {^ u aX + u jk X k )} 

3=3 k—3 U ‘ l 

n+3 n+3 a i * 7’ 

+ 

j=3 Jt=3 

Multiply by q t and summing over all i gives: 

Mi 


o = 


n+3 n+3 n+3 f) A •• T •• T 

E E E TR {jfc(U lk A k + U ]k A k fa) 

t = 1 j=3k=3 u<it 


n+3 n+3 n+3 o . , x 

i= 1 j=3 fc=3 ^ 

n+3 n+3 •• T • - T 

= T,H TR {A J U ]k A k + A.t/.U*)} 

j=3 Jt=3 

n+3 n+3 . -j. 

+ 7Etr*(AM) 

j=3 Jt=3 

dK - - " T 

■ + EE r *iw*) 

j=3 A:=3 
n+3 n+3 ^ 

+ 7EE r *(VA] 

j=3 Jt=3 


dt 


n+3 n+3 

v(t) = -^^Tfl{e jfc (A t -7A,) T +}-27A- 

J=3 Jt=3 

n+3 n+3 . ■j’ 

- EE 

j=3 fc-3 

Substituting in the adaptation equation 16 gives: 

V(t) = -2 7 A' < 0 


Hence, 0 < V(t) < F(0) < 00, or 0 < V(0) - F(t) < 00. 

From the equivalence of finite dimensional vector space norms, 
there exist a positive constant j 3 such that: 


Therefore, 


q T q < fiK 



< 


< 



£ 

27 


too 

/ - V(t)dt 

Jo 


^[V(0) - V(oo)l 
00 


Therefore, q is an L 2 function and, hence, q e converges to zero, 
which is the desired result. 


3.4 Recursive Formulation of Controller 

The computational efficiency of the control law is greatly im- 
proved by writing the equations in a recursive form. First we 
define: 

R( Sk ) = To'R(z k )T 0 
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This matrix R(s k ) is simply R{& k ) referred to the Floating Ref- 
erence Frame. The vector s k has the same interpretation as & k 
defined in equation 4 except that all the vectors are defined with 
respect to the floating reference frame. Let: 

R M = To\R(v k ) - R(xo))T 0 = 

i~\ 

Then for A k we have: 

Ak = R(v k )A k 
R(v k ) = R{v k -i)+ R{sk)q k 
R(v o) = 0 

For A k : 

A k = R(v k )A k 
R{v k ) = + R{s k )'q k 

R(v o) = 0 

and for Ajt: 

A fc = R(v k )A k 
R(v k ) = R{ Vk-\ ) + R(s k )q k 
R(vq) = 0 

For, Ajt: 


A)t = (R{v k ) + R(v k )R(v k ))A k 

R(v k ) = R{v k -i) + R(s k )q k + R( s k)q k 

= R(v k -i) + R(s k )^ k 
+ (R(v k )R(s k ) - R(s k )R{v k ))q k 
R(v 0 ) = 0 

These, equations are computed recursively from the Floating 
Reference Frame to the end- effector, link n -f 3. 

Next we define: 

Fjk = A J U lk (X k - yA k f 

n+3 

r, = £ F jk 

k = 3 

and 

n+3 

fi = ^Fi = Fi + f i+l 

f n+4 ~ 0 

This equation is computed recursively from the end-effector, link 
t = n + 3 to the Floating Reference Frame. 

Finally, the input is computed: 


Pi = TR{R{s x )f t ) (19) 

Note that: 

dAj _ f R(s{)Aj if i < j 
dqi ~ I 0 if i > j 


4 Conclusion 

An efficient algorithm for the adaptive control of a space based 
robot has been presented. The method makes no assumptions 
on the initial estimates of the inertial parameters or the initial 
momentum of the system. Only the position and velocities of the 
manipulator joints and the Base orientation angles are required 
by the controller. 

The first part of the paper develops the dynamic equations of 
motion for the system. Key to the method is the use of reaction 
wheels to control the orientation of the Base and the elimination 
of the Base linear motion from the equations of motion. It was 
shown that the effect of the reaction wheels on the dynamics 
of the system can be divided into two components. The first 
was the component related to the generalized momentum of the 
reaction wheels. The remaining component can be effectively 
included in the dynamics by modifying the inertial properties of 
the Base. The linear motion of the Base was removed from the 
equations of motion by using the law of conservation of linear 
momentum. With these two transformations, the resulting form 
of the kinetic energy was easily utilized in Lagrange’s equation 
to obtain the dynamic equations of motion. 

The algorithm used in the implementation of the adaptive 
controller is a modification of that presented for terrestrial based 
manipulators [14]. The primary differences are due to the use 
of homogeneous transforms in the equations of motion. For ex- 
ample, inner products of vectors become inner products of ma- 
trices. Another difference is the choice of the vector norm used 
in the stability proof. For terrestrial based manipulators this 
is directly related to the total kinetic energy of the manipula- 
tor. For the space based manipulator, this was related to the 
total kinetic energy minus the component due to the generalized 
momentum of the reaction wheels and the translational kinetic 
energy component. 

A recursive form of the control algorithm was presented for 
computational efficiency. The computational load is still fairly 
high and increases quadratically in the number of links in the 
system. Due to the coupling of the dynamics, there do£s not 
seem to be any way to avoid the quadratic complexity problem. 
Since it is known that U j k == some computational improve- 
ments could be made with a slight modification of the adaptation 
law such that only Uj k is estimated instead the current method 
of estimating both U j k and U kj . However, this does not appear 
to produce very significant improvements. A more promising 
approach might be to avoid all of the coordinate transforma- 
tions by referring the velocities, accelerations and forces to their 
own link coordinates. For example, one would compute A k l A k 
instead of A k and AJ l F jk (A k 1 ) T . instead of F jk . 

A significant extension of these results would be the solu- 
tion for manipulators containing closed kinematic loops, since 
these are the most common types of manipulators encountered 
in practice. This would also lead to methods for dual arm coor- 
dinated motion control and compliant motion control. Another 
extension would be an adaptive Cartesian coordinate controller. 
This allow two manipulators mounted on different bases to work 
in a coordinated manner. 
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